function X=computeX(A, B, lastX, lastU)
X = A * lastX + B * lastU;
end